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ABSTRACT 


A program was developed to improve the on-line 
measurement capability of the three-dimensional, 
underwater tracking ranges at the Naval Torpedo 
Station, Keyport, Washington. The program utilizes a 
Kalman filter routine to minimize the effects of 
measurement noise in determining the true target 
position. The gain schedule used by the filter is 
calculated off-line and may be varied based on 
tracking requirements. Listings of both of the 


Fortran programs are included. 


Simulated exercises were run utilizing a variety 
of gain schedules. Results of these Simulations will 
assist NTS engineers in the implementation and 
Operation of the program uSing the NTS computer 
LacmiLlty. Details of the simulation procedure anda 
listing of the track generator program are included. 





TABLE OF CONTENTS 


OU COIN s 5 5 ee ales ie 0 se se sees oes 6s ase sees se oes ss 7 

5 THEORY. cece www ec cee ce cee e reer eee ce cscs esccecas 8 
WEE. FROBEERG DEFINITION. .. cece cscs ese w enw eres esssasce 10 
EV. PROGRAM DESCRIPTIONS «6 ccc ccc cance car cccccccesesccce 14 
De) 8 RALTAW Pers ow ww tw eee tees een setsessoess os 14 

B. GALN SCHEDULE... sence wes TRE ee oe 1S 

C. TRACK SIMULATOR 2 2 cece cc cccs ccc crac ccccce cece ce 16 

Via (SO Ciw EOS POs 6 kc ct tt tw th we 6 es eee se 17 
Ve SUAS sc wc ec occa te eee sa cee esse see w sa te 
As TRONS BABU VERING TARGET... we ccc ccc ccsessesenne Lt 

Be (GhRNIE RANGE ARG ED ewiss «cc cece ees ses cess bese sain ece 

Ce) VhEGwi— MANURE NG SAHGEL . « <5 66s 6 «6 4s 46 is ales) 6 ounces 

Vol.) CONGCLUSZONS “AD RECOMMENDATIONS .c.ccsacccscaavae ss Poo 
Appendix A: GAIN PROGRAM DESCRIPTION AND REQUIREMENTS.. 31 
Appendix B: KALMAN FILTER PROGRAM DESCRIPTION AND 
ECO) UMP MEME MeWet «5-01 lo folelerete ee 6 co sileie «ice 0 00 0000 0 6 60 0 00 ee Fistenegey POE 
Appendix C: TRACK SIMOLATOR PROGRAM DESCRIPTION AND 
Bee ets o)e eels es es) < os eo sles esos sees sae 6 os etetelelchameme cleus ) 5 
Mamicmdns Ds GAINS PROGRAM LISTING.... wcsescacsccesucwase SO 
Appendix E: KALMAN FILTER PROGRAM LISTING..........-. ee 0, 
Appendix Fs TRACK SIMULATOR PROGRAM LISTING...... 2 ccc 43 
weve DiS TR ESOLEON Lisle ss os 0s 0 6 0 0 6 066 0 0 80 6 00 0 © cee ele cme 
PaO ees P eet 5 221s) es) es os © 0 6 66 4 <a 0 a0 0 6 6s ¢ ols eisai epanenat mee 





(This page intentionally blank) 





The Naval Torpedo Station, Keyport, Washington currently 
operates two three~dimensional underwater tracking ranges 
With the capability of accoustically tracking torpedoes and 
Similar water-borne targets. The computer system in use 
provides a printed record and plotted display of the 
measured track. AS with most tracking systems the measured 
data 1s corrupted by noise. This noise is due to the 
combined effects OF environmental factors and the 


measurement instruments. 


These noisy tracks are later analyzed to remove those 
measurements judged to be most inaccurate on the basis of 
total track statistics. Ihus, it is only at some later time 


that a smooth representation of the track is available. 


In the near future an updated computer system will be 
brought on-line. The necessity of designing new programs 
provides the opportunity for expanding the real-tine 
capability of the system. It is desired that a smoother 
track be available in real-time without the loss of any of 
the measured data. A long range prediction capability and 


the ability to handle various data rates is also desirable. 


The above reguirements and the ready access to the noisy 
measurements of target position indicate the applicability 
on a Kalman filter routine to improve the real-time 


capability of the three-dimensional tracking ranges at NTS. 








The development and use of the equations used in the 
Kalman filter have been widely documented. Rather than 
include the derivation here the reader is referred to [1,2] 


or similar works. 


In this presentation the equations used will be listed 
With a brief description of each. The system is assumed to 


be linear and free of deterministic forcing inputs. 


We characterize the state by the following state 
difference equations 
X (k+1) = PHI * X(k) + GAMMA * W(k) 
and noisy measurement equations 
Z(k) = C * X(k) + V(k) 


where 

X(k) is the n-dimensional state vector at time K 

Z(k) is the m-dimensional measurement vector at 
time K 

V(k) is the m-dimensional random noise vector at 
tine 


W(k) is the m-dimensional random forcing input at 
time K, and 


PHI and C are constant matrices. 


The estimator equations are given by 
NN “A A 
X(k1k) = X(k{k-1) + G(k)¥*[Z(k) - C * X(k{k-1) ] 
and 
A A 
X (k[k-1) = PHI * X(k-1{k-1), 
where 


\ 


X(k{k) ais the estimate at time K given K 





measurements 

“A 

X(k[k-1) is the estimate at time K given K-1 
measurements, and 


G(k) is the Kalman filter gain at time kK. 


The estimator is initialized by setting X(0|-1) equal to 


the mean of the random target entry points. 


The gain (G) and theoretical covariance of error (P) 
equations are given by _ 
G(k) = P(k[k-1) * C'* [C#¥P(k]k-1) *C + R(k) ]}-2 
P(k{k) =[{[I - G(k) *C]*P(k{[k-1) 
P(k+1{k) = PHI*P(k[k) *PHI' + Q 
where 
R(k) is the covariance of the measurement noise, 
P(k{/k) is the theoretical covariance of the 
estimation error, and 
Q is found by 
w= GAMMA*cov(W) *GAMMA’ 
where cov(W) is the covariance of the forcing input. In 
this application the measurement noise causes fluctuations 
in the velocity estimate suggesting that there is an 
acceleration input. This "acceleration" is treated as a 
random forcing input. 
GAMMA 1s given by 


Te/z 


These eguations are initialized by setting P(0{-1) egual 


to the variance of the intiial state estimate. 





fit. PROBLEM. DEFINITION 


The design and formulation of a new tracking program may 
best be defined in terms of the present system and the 
improvements to be made. Details of the reduction of the 
accoustically measured track into the usable data format of 
XYZ positioning on the ranges are included in [3]. Lt ss 
assumed that all data has been reduced to the three- 
dimensional coordinates for convenient use as track input to 


the progran. 


Under the present system, data is received and stored on 
magnetic tape for later smoothing. simultaneously, the 
measured position of the target is printed with other 
pertinent data (time, point count, array number, etc.). Two 
plots are also generated: target position 1s superimposed on 
a range chart in XY coordinates; and, target depth is 


plotted in XZ coordinates. 


The typical torpedo track wiil have two modes: search 
and pursuit of its target. The search mode consists of a 
helical track that does not lend itself to linear 
approximation. Because this portion of the track is of 
Minor importance to range observers, any inaccuracies caused 
by a linear approximation can be tolerated. The pursuit mode 
will be a constant velocity track which can easily be 


modeled by a linear, time-invariant systen. 


The Kalman filter (See Figure 1) provides an accurate 
discrete approximation to the continuous target track. 


The current smoothing technigues (post-run analysis) 
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Figure 1 - BLOCK DIAGRAM OF THE DISCRETE KALMAN FILTER 








remove those points that are the most corrupted by noise. 
This type of routine initially considers all of the measured 
track points. The position at any time is then estimated 
based on all of the measurements. The resultant track is an 
error minimizing curve fitted to the complete measured 
track. The use of the Kalman filter will not affect this 
type of post-run analysis, as all of the measurements are 
retained. The filter will, in real time, provide a smoother 
track through the use of the predictor and weighted (the 
Kalman gain) correction factor. Thus, by using the filter 
we are able to overcome the problem of noisy measurements 
without the loss of data. 


Many of the required computations can be completed 
off-line so as not to jeopardize the timely application of 
the filter to the track data. Because the geometry of the 
tracking range will remain the same, we can utilize 
previously run tracks to develop a reliable set of 
measurement noise statistics. These statistics will then be 
used to compute the Kalman gain schedule, which may then be 


stored for use at the appropriate time. 


Use of a priori knowledge of the noise statistics allows 
the programmer and user not only to precompute the gain 
schedule but also to test the program via Simulation. 
Varlations, such as allowances for various degrees of 
Maneuverability, may also be compared. We are able to base 
the assumptions of measurement errors on noise criteria 
only, because the assumed location of the array hydrophones 


has been shown to be highly accurate. [4] 


Two general assumptions have been made about the noise 
in the application of the filter. Pirst, it is assumed that 
the measurement noise is random with a mean of zero and has 
a GausSian distribution. Also, the noise has been taken to 


be independent of the distance between the target and the 


WZ 





array sensors. This assumption is made with consideration 
given to the ray path reconstruction routine used. 


Us 





IV. PROGRAM DESCRIPTIONS 


Se ee Se ES ea see Se cee 


A. THE KALMAN FILTER 


The Kalman filter program has been designed to provide 
an improved tracking routine using a minimum of computer 
storage and computation time. The filter routine has the 
capability cf processing a variable data rate limited only 
by the execution time of the routine and the accuracy 
desired (in the discrete approximation). This data rate is 
selected prior to each run, as 1s the advance prediction 


feature. 


In addition to the normal one-step-~ahead prediction of 
the filter, the user may select a long range predictor prior 
to each track run. This feature will enable observers to 
evaluate qualitatively parameters such as torpedo homing 
capability during the test run. The long range predictor 
Simply advances the current filtered position the desired 
number of sample intervals. The current filtered velocity 


estimate is used in this prediction. 


The operation of the filter may adversely be affected by 
large scale measurement errors. Range operations experience 
indicates that measurement errors on the order of 103 feet 
are occassionally recorded. One error of this magnitude 
would invalidate the filtered output for many subsequent 
Sample intervals. Because of the feedback operation of the 
filter there must be protection against this form of 


catastrophic failure. 
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This protection is provided by establishing limits of 
acceptability about each of the measurements. The range of 
this acceptability "gate" is adjustable and may be set by 
the user prior to each exercise run. (See Appendix B on 


program requirements for a further explanation.) 


Measurements that fall outside the gate are regarded as 
unacceptable; the gain schedule is set to Zero for that 
measurement and the filter is advanced based on prior 


estimates. 


The program is liberally documented through the use of 
"comment" cards. These comments will enable any user to 
operate the program with a Minimum of supportive 
documentation. It is intended that only a basic knowledge 
of Kalman filtering and Fortran programming are necessary to 
operate the program. Ease of implementation has been given 


a high degree of consideration in the design of the progran. 


B. THE GAIN SCHEDULE 


The Kalman gain schedule is calculated using a program 
independent of the filter routine. This separate progran 
permits prior off-line computation and storage of the gain 
schedule. For a given tracking run the optimal gain 
schedule may be computed from the matrix inputs to the 
routine. These gains are then stored for use during the 
actual tracking exercise. If the user chooses to alter the 
gain schedule used, the independence of the gain progran 


from the filter provides flexibility. 
In Operating the filter, any gain schedule (optimal or 


Sub-optigal) may be used. For example, a higher gain value 


applied to each measurement would allow for a higher degree 
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of target maneuverability, but would provide less smoothing. 


This program is completely self-supportive; it reguires 


no additional subprograms or routines. 


C. TRACK SIMULATOR 


A track simulator program is also included. Its 
inclusion iS not necessary to operate the Kalman filter 
noutane at «NdS« It is included here only to acquaint NTS 
engineers with the simulation technigue used in program 


testing and verification. 


The track generator uses a random number generator to 
select a track origin. The track is then advanced from that 
point based on user selected X Y and Z velocities. The 
actual track 1s then corrupted by noise to provide noisy 


position measurements. 


The actual track and the measured, noisy positions are 
available as program output. 


This program uses the subroutine SNORM, an IEM-360 


library subroutine. SNORM is a random number generator that 


produces a normal Gaussian distribution. 
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The Kalman filter program was designed to handle 
efficiently (in terms of computer usage) the tracking 
measurements and to provide the extra features desired by 
NTS range observers. ‘Once completed it was necessary to 
verify accurate operation of the program in an iS 
CVange-type environment. One means of verification was to 
model the working environment and to conduct tracking 


exercise simulation using the nodel. 


Several simplifying assumptions have been made in the 
model. Simplification was made only where it was determined 
that no cenflict existed wich realistic Operational 
parameters. The primary reason for making these cnanges was 
to increase the readability of the printed and plotted 
Output data. 


In the test model, the target track was generated uSing 
velocity along the range baseline only. Originally the 
track was modeled with principal motion along the range 
baseline (X-axis) and a slight crossing trajectory (Y-axis). 
By eliminating the Y-component of velocity the magnitude of 
the noise corruption is represented as the full range of the 


absissa on the XY position plot. 

The program was tested using a track that incorporated 
velocity along each of the coordinate axis but analysis of 
the filtered output data showed no change in the performance 


of the filter. 


Various target velocities were used for program 


17 


~~ 
<<ciliinaaaa - | ‘- : 





verification. No differences in performance were noted over 
the velocity range from twenty to firty-five knots. The 
final model employs a target moving at forty knots (a 


displacement of ninety feet between measurements). 


Two considerations were made in computing the gain 
schedule used in testing. Statistical data obtained from 
previous range tracking exercises was used to initialize the 
gain computations. Additionally the Q matrix was varied to 
test the the degree of manuverability that could be handled 
by the filter. 


No attempt was made to test directly the "gate" feature 
of the filter. However, measurements greatly corrupted by 
noise were noted in each of the Simulations, providing a 
test of the filter's ability to reject highly erroneous 


measurements. 


No attempt has been made to distinguish which particular 
array supplied the data. It was noted in the problen 
definition that input data to the filter was assumed to be 
in three-dimensional range coordinates. It has been assumed 
that current methods of calculating three-dimensional data 
Will be retained and will provide measurement input to the 
filter in terms of the range baseline coordinate systea. 
Based on this assumption there is no need to determine which 


array supplied the data. 


The primary purpose of the simulation has been to test 
operation of the filter in such a manner that it might be 
implemented at NTS, Keyport with only minor changes. 
Attempts have been made to anticipate and to resolve any 


problems that might arise. 
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After the Kalman filter program had been designed and 
checked for Fortran and logic errors, it was necessary to 
test it in an environment similar to that seen in actual 
Tange operations. Computer modeled simulations provided a 
rapid, lcw-cost method for verifying the accuracy of the 
progran. Several tests were run uSing a variety of 


operational parameters, as explained below. 


Most of the measured data from the NTS ranges is 
received at about 1.3 second intervals. The few remaining 
exercises utilize a data rate one-half the above. These 
data rates establish the absolute limits of any processing 
routine. One of the important aspects of the simulation is 


the cycle time of the filter. 


All of the simulation exercises were conducted using the 
IBM-360 system at the Naval Postgraduate School under a 
time-~shared mode. The tests were conducted at various times 
of the day when system user load ranged from moderate to 


heavy. 


The average time of operation of the filter was 1.4240 
hundredt hs-of-a-second. Given this wide Margin of 
aceeprapility, it is assuned that no difficulty will arise 
when the filter is operated on the NTS range computer 


systen. 
In the Kalman gain schedule, the steady-state values 


were achieved after seven to twelve sample intervals 


depending on the input values assigned to the Q matrix. The 
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gain 


expected to undergo little or no maneuvers (accelerations of 
less than 3.2 feet/second2). 


schedule shown in Table 1 is based on a target that is 


For all measurements after the 


last indicated time the gain values are equal 


value listed. 


TIME 


Ow ana Mm & Ww NY w 


WO 


10 
11 
Z 
13 
14 
15 


Table 1 - GAIN SCHEDULE FOR A NON-MANEUVERING TARGET 


POSITION 
GAIN 


0.990099 
0.994248 
Us dooeo 6 
Ver 2oatcg 
0.669428 
0.649976 
0.646037 
0.645805 
0.645766 
0.645621 
0.645519 
0.645481 
0.645474 
0.645474 
0.645474 
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VELOCITY 
GAIN 


0.0 

0.754539 
U,398e 22 
0.284304 
252 9515 
0.248808 
0.249742 
0.250140 
0.250005 
0.249853 
0.249798 
0.249792 
0.249794 
0.249794 
0.249794 





Two other gain schedules were used in the simulation and 
are shown in Tables 2 and 3. These schedules assume target 
accelerations of 10 feet/second2 and 20 feet/second2, 
respectively. Again the last values shown are the 
steady-state values and are to be applied to all subsequent 


measurements. Pe 


A. NON-MANEUVERING TARGET 


When the target is in a non-maneuvering mode the only 
fluctuations from its track will be due to noise. Because 
this noise corruption is undesirable, the gain schedule used 


should provide for maximum smoothing of the target track. 


The gain schedule (Table 1) was calculated assuming that 
the initial position estimate could be determined within 
+100 feet of the actual position. By assuming that the 
Variance due to the noise would be approximately three 
feet/second?, maximum smoothing with an allowance for slight 


irregular target accelerations was achieved. 


Using these gains with a simulated noisy track, the 
filtered fosition estimates were statistically compared with 
the measured positions and the known true track. The 
deviation of the filtered track points from the true track 
Was approximately one-half that displayed by the measured 
positions. The standard deviation of the filtered track 
estimates about the true track was approximately equal to 
the theoretical value predicted in the calculation of the 
gain schedule. This favorable comparison of experimental 
and theoretical values indicates that proper initial values 


have been used in calculating the Kalman gain schedule. 
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TILE POSITION VELOCITY 
GAIN GAIN 

1 0.990099 0.0 
pugs 273 eeoesHeWs 
3 0.869084 0.548191 
4 0.843011 0.553351 
5) Yorsaess, onsssven 
6 0.842387 0.554583 
7 0.842279 0.554577 
a  Onelez7e  O.ssase7 
om Someine7s 0. Sous 
10 GOWelie27Smemonsouses 
ide OMeae 27S eeOmeStices 


Table 2 - GAIN 


(APPROXIMATELY 1/3G ACCELERATION) 
TIME POSITION VELOCITY 
GAIN GAIN 

1 0s 97099 0.0 
Z 0.994342 0.767076 
3 0.915940 Ue 596054 
+ 0.915308 02769307 
5 0.914846 0.764878 
6 0.914830 0.764944 
7 0.914828 0.764940 
8 0.914828 0.764940 
g 0.914828 0.764940 


SCHEDULE FOR A MANEUVERING TARGET 


Table 3 - GAIN SCHEDULE FOR A HIGHLY MANEUVERING TARGET 
(APPROXIMATELY 2/3G ACCELERATION) 


Zz 





Portions of the noisy track and filtered track are shown 
in Figure 2. While the noise corruption cannot totally be 
eliminated, the filtered track does provide a truer 
representation of the actual target path. Further 
improvement can be achieved by applying current post-run 
smoothing techniques to this filtered track. 


B. MANEUVERING TARGET 


Por tracking exercises run with a target that is known 
to be maneuvering, the gain schedule can be adjusted to 
follow those maneuvers. If, for example, the exercise is to 
be run with a MK 30 simulator programmed for maneuvers 
involving accelerations of less than 10 feet/second?2, a gain 
schedule as listed in Table 2 would be used. The higher 
gain values needed would reduce the quality of the real-time 


snoothing. 


The degree of smoothing accomplished can be seen in 
Figure 3, a comparison of portions of the tracks obtained 
from raw, measured data and data smoothed using the gains 


derived for a maneuvering target. 


The reduction in the quality of smoothing may be seen in 
Figure 4. These filtered tracks were obtained using the 
Maneuvering and non-maneuvering gain schedules. Both tracks 


were obtained from the same set of noisy, measured data. 


Again, the deviation of the filtered track points about 
the true track is less than that displayed by the measured 
positions. Favorable comparison was made between the 


experimental and theoretical values of the error statistics. 
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Figure 2 ~ COMPARISON OF THE NOISY AND FILTERED TRACK POINTS 
FOR A NON-MANEUVERING TARGET 
The gain schedule used to produce the smoothed track 
above is for a non-maneuvering target. The degree of 


smoothing attained 1s seen by comparison of the measured 


track points (X) and the filtered track points (curve). 


The gains listed in Table 1 were used to filter this 
data. This plot represents the maximum smoothing achieved 
in the simulation. The magnitude of the Y-axis fluctuation 


is due to measurement noise only. 
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Figure 3 ~ COMPARISON OF THE NOISY AND FILTERED TRACK POINTS 
FOR A MANEUVERING TARGET® 


The gain schedule used to produce this smoothed track 
is for a maneuvering target. Again comparison is made 
between the noisy track measurements (X) and the filtered 


track points (curve). 


The gains listed in Table 2 were used to filter this 


data. Again the Y-axis fluctuation is due to measurement 


noise only. 
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Figure 4 - COMPARISON OF THE FILTERED TRACKS USING THE 
MANEUVERING AND NON-MANEUVERING GAIN SCHEDULES 


The plot shown above is a comparison of the difference 
in the degree of smoothing achieved with the gain schedules 
previously used. The non-maneuvering, filtered track from 
Figure 2 is displayed with a (X), and the maneuvering 


filtered track of Figure 3 is shown by the curve. 
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C. HIGHLY-~MANEUVERING TARGET 


One additional simulation was run assuming a target 
accelerating up to 20 feet/second?. This high acceleration 
might be expected if an attempt was made to follow a torpedo 
through both the search and pursuit phases of its track. 
Allowances for high acceleration substantially increase the 


gain values (Table 3). 


With these high gains most of the smoothing effect of 
the filter is eliminated. This point is best illustrated in 
Figure 5, a comparison of measured and filtered portions of 
the simulated track. 


Care must be exercised when the gains are adjusted to 
follow large maneuvers. If the gate value is set too low, 
eaertilter wali failto fuwaction- In this test it was 
necessary to double the value of the gate limits (+100 feet) 
used in the two previous simulations. (Further explanation 


of the gate feature is included in Appendix B.) 
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Figure 5 - COMPARISON OF THE NOISY AND FILTERED TRACKS FOR A 
HIGHLY MANEUVERING TARGETe 


The gain schedule used to produce the filtered track 
above is for a highly maneuvering target. Almost a total 
lack of smoothing is noted in comparison of the noisy track 


measurements (X) and the filtered track points (curve). 
The gain schedule listed in Table 3 was used in 


processing this data. The ability to follow large maneuvers 


results in the lack of smoothing seen. 
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The Simulations conducted using the Kalman filter 
program indicate that it will provide improved, real-tine 
tracking data for operations on the three-dimensional 
underwater ranges at the Naval Torpedo Station, xXeyport. 
The filter accomplishes a partial smoothing of the target 
track in real-time as well aS providing the long range 
prediction capability desired by NTS range engineers. Both 
of these features will substantially improve the quality of 


service provided to NTS range users. 


Additionally, either the filtered position estimates oF 
the actual measurement data may be used in any type of 
smoothing algorithm to obtain the type of post-run analysis 
currently available. The smoothing accomplished by the 
filter will provide a higher guality input to the post-run 
analysis, resulting in a smootaer final track than has been 


previously attained. 


With the exception of minor input/output change 
requirements, the gain and filter programs are ready for 
implementation at range computer facilities at NTS. 
Explanation of these changes is included in tne program 


requirements, Appendices A and B. 


Based on the assumption that the search mode of any 
torpedo tracking exercise 1S insignificant, the optinal 
tracking and smoothing can be accomplished uSing the gain 
schedule suggested for a non-maneuvering target (Table 1). 
Before implementation additional testing and comparison aay 


be desirable using exercise data obtained under a variety of 
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operating conditions at NTS. 


In the future, additional improvement to the tracking 
system may be accomplished by altering the data input 
format. As stated earlier, the target's measured position 
expressed in the three-dimensional coordinate system of tae 
range was used as input to the Kalman filter progran. 
Direct application of the time signal to a filter sequence 
has not been considered at this time. This application may 
be considered as a possibility on futher program 
development. 


Several references have been made to the smoothing 
techniques used in current post-run analysis. No attempt 
has been made to apply such methods to the filter output as 
Simulated. It is recommended that the filter be applied to 
previously recorded, range-tracking data and the smoothing 
alogrithnm then be applied to this filtered output. 
Comparison should then be made between the filtered and 


measured smocth curves. 
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APPENDIX A 


GAIN PROGRAM DESCRIPTION AND REQUIREMENTS 


The Fortran program GAINS was designed to compute a 
Kalman gain schedule based on user selected input matrices. 
The gain and covariance equations listed in Chapter II were 


used in the computations. 


The user must input the following integer variables: 
the dimensicn of the state vector (NS6); the dimension of 
the measurement vector (MS3); and, the number of gains to be 
calculated (ITIMES200). 

rd 

ITIME will normally be set only high enough to insure 
that the steady-state value of the gains is reached. fTfhis 
value will usually be less than thirteen. If a permanant 
change is desired, the dimensions of GK and PKK (line 2) 
should be changed to read "GK(6,3,XXX)" and "PKK (6,6,XXX)" 


where XXX represents the desired value. 


Additional input reguirements are the following 
matrices: PHI, the state transition matrix (dimensions 
NxN) 3; C, the measurement matrix (MXN); R, the variance of 
the measurement noise (MxM);  PKKM1, the variance of the 
initial state estimate (NxN); and, Q, the variance of the 
random forcing input (NXN). All of these matrices should be 
input in fixed point arithmetic with no single value 


exceeding ten characters. 


As currently written, the program output is limited to 
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two gains (position and velocity) and the associated 
Variances and covariance. If additional values are desired, 
it is necessary to change only statements 43 and 45 as noted 
in the program listing. The actual gain calculations are 
performed in SUBROUTINE GAIN. Other subroutines are used to 
perform the necessary algebraic calculations. 


The prcgram output will be a gain schedule and 
theoretical covariance matrix of the specified length 
(ITINE). These values are output to separate files. The 
gain output is used as input to the filter program which is 


currently written to read 13 gain values. 
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APPENDIX B 


KALMAN FILTER PROGRAM DESCRIPTION AND REQUIREMENTS 


This pregram requires input from three sources. 
Thirteen values of the gain schedule are read via file 
three. The actual target position measurements are input 
via file four. The program is designed to terminate when 
the measurement value of the X position exceeds 105 feet 
(see line 95). Several values must be input by range 
observers prior to each run. These values are the initial 
state estimate (six fixed point numbers, each of less than 
eight characters), the sample interval, long range predictor 
and measurement gate value (each of fixed point numbers with 
up to ten characters each). 


The long range predictor is scaled in sample intervals, 
NOT units or time, so care must be exercised to obtain the 


desired value. 


The gate value is used to reject measurements that are 
obviously erroneous. This value must be set high enough to 
allow adequate operation of the filter and still perform its 
EUNCELON . In the non-maneuvering simulation the value was 
set at 50 feet with a standard deviation of ten feet in the 


generated noise. 


As written the program output supplies the predicted, 
measured and filtered position values and filtered velocity 
estimate. Three statements (124,128,130) output these 
values to one file with all X values listed first followed 
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by all Y values and then Z values. 


Upon implementation at NTS, all filtered (position and 
velocity) and measured (position) values may be output by 
rewritting line 124 and the associated FORMAT statement 
(#300, line 134). ff this change is made lines 127 through 
130, inclusive, should be deleted. 


The dimension statement (lines 1,2) should be changed so 
that XKKM1, 2Z, and XKK will be able to handle the expected 
number of méasurementS in any given exercise fun. Bee 
present they are set at 200 (approximately four minutes with 
a sample interval of 1.31072 seconds). 


The program contains additional comments to facilitate 


its use. 
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APPENDIX C 


TRACK SIMULATOR PROGRAM DESCRIPTION AND REQUIREMENTS 


The simulator program requires no input. The randon 
humber generator (SNORM) used to determine target entry 
point and measurement noise is seeded with two arbitrary 
values included in the program (lines 5,6). If the seeds 
are changed they must be odd integer values of eight or 


fewer characters. 


This pregram generates a 200 point true track (xX) and 
adds random noise to each track point to obtain a noisy 
measurement (Z) . The two tracks are output to separate 


files. 


The program contains additional comments to facilitate 


eS use. 
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